3D Trilateration